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@ Verfahren zur Kollisionsvermeidung mit Hilfe eines Lenk- 
winkelfeldes fur eine autonome mobile Einheit 
Mit der Erfindung wird ein verbessertes Verfahren zur 
Orientierung von autonomen mobilen Einheiten vorgestellt 
Dabei werden aufgrund der Lenk- und der Antriebsgeome- 
trie der fahrbaren Einheit Kollisionsabstande zu Hindernissen 
ermittelt und aufgrund dieser Abstande eriaubte Lenkwinkel- 
bereiche fur die Bnheit definiert. Zusatzlich wird fur die 
Sensorausrustung der Einheit ein definlerter Beobachtungs- 
horizont vorgegeben, in welchem Hindemisse ausgewertet 
werden sollen. AuBerdem wird um die Einheit herum ein 
Sicherheitsbereich definiert, in welchem sich keine Hinder- 
nisse befinden durfen. andemfalls wird eine Ruckwartsfahrt 
ausgeldst. Zur Fahrwegoptimierung der Einheit werden 
Lenkwinkelbereiche, welche sich aus unterschiedlichen Be- 
obachtungshorizonten und Sicherheitszonen ergeben, fall- 
weise kombiniert 

Durch eine Herabsetzung des Sicherheitsabstandes lediglich 
in engen Passagen bis im Extremfall zur Gehausekontur der 
Einheit, kann dort der maximal mogliche Lenkwinkel einge- 
schlagen werden. Dadurch wird ein hdchstmogliches MaS 
an Manovrierbarkeit auch zwisch'en eng beieinanderstehen- 
den Hindernissen gewahrlaistet. 
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Beschreibung 



Durch Sensoren gestutzte Bewegung autonomer mo- 
biler Einheiten in komplexen, eng mit Hindernis sen 
bestellten, unbekannten Umgebungen, wie zum Beispiel 5 
BQros oder Wohnungen, stellt eine betrachtliche Her- 
ausforderung an die Steuerung und die Datenauswer- 
tung der mobilen Einheit dar. Eine solche Einheit, bei- 
spielsweise ein Roboter ist nur fahig nfltzliche Aufgaben 
durchzufuhren, wenn sie sich zielstrebig in ihrer Umge- 10 
bung bewegen kann und auch uber mehrere Stunden 
hinweg Hindernisse vermeiden kann. 

Da der Bewegungsraum der Einheit meistens unbe- 
kannt ist und sich meistenteils auch dynamisch veran- 
dert, ist es sinnvoll die meisten Details welche die unmit- 15 
telbare Bewegung der Einheit betreffen lokal zu ermit- 
teln. Konsequenterweise wird deshalb zwischen der Pla- 
nung, welche eine Folge von Zwischenzielpunkten lie- 
f ert und lokaler Mandvrierung, deren Aufgabe es ist die 
autonome Einheit von einem Zwischenziel zu dem nach- 20 
sten Zwischenziel zu bewegen unterschieden. FQr diese 
Aufgabe werden schnelle Mechanismen bendtigt, die es 
erlauben Hindernisse gesichert zu vermeiden und die 
trotzdem eine hohe Beweglichkeit der Einheit gewahr- 
leisten. Die Einheit sollte sich in unvorbereiteten Umge- 25 
bungen ohne Vorausinformation bewegen kdnnen und 
dies mit einer angemessenen Geschwindigkeit (ca. 
50 cm pro Sekunde) konnea Dabei kdnnen die typi- 
schen Abstande zwischen Hindernis sen in der GrdBen- 
ordnung der Abmessungen der autonomen mobilen 30 
Einheit oder kleiner sein. Die Passagen, welche sie bei 
ihrer Fahrt durchqueren mQssen kdnnen dabei auch 
sehr eng sein. Hindernisse (zum Beispiel Personen) kdn- 
nen sich mit einer Geschwindigkeit die vergleichbar ist 
mit jener der Einheit bewegen. Dies fQhrt dazu, daB die 35 
meiste Zeit die selbstbewegliche Einheit an den Gren- 
zen ihrer Sensorausstattung bzw. ihrer geometrischen 
und kinematischen Beschrankungen arbeiten muB. Er- 
schwerend kommt hinzu, daB falls Ultraschallsensoren 
eingesetzt werden diese den Nachteil einer Nahbe- 40 
reichsblindzone und einer niedrigen Feuerrate haben. 

Folgende grundlegende Arbeiten auf dem Gebiet der 
Orientierung von autonom operierenden mobilen Ein- 
heiten sind bekannt: 

R. Bauer, W. Feiten, G. Lawitzky: Steer Angle Fields: An 45 
Appro ach to Robust Manoeuvring in Cluttered, Un- 
known Environments, Proc Int. Workshop on Intelli- 
gent Robotic Systems, pp. 67 bis 70, July 1993. 
J. Borenstein, Y. Koren: "Histogrammic In-Motion Map- 
ping for Mobile Robot Ostacle Avoidance", IEEE Trans. 50 
on Robotics and Automation, VoL 7, No. 4, August 1991. 

Trotz der umfassenden Arbeiten auf dem Gebiet der 
selbstbeweglichen mobilen Einheiten, gibt es immer 
noch Schwierigkeiten bei der Auswertung von Sensor- 
informationen und bei der Gewahrleistung einer schnel- 55 
len Reaktion auf sich dynamisch andernde Umgebun- 
gen, sowie der Berflcksichtigung dieser Veranderungen 
im Zusammenhang mit einer lokalen Orientierung von 
autonomen mobilen Einheiten. 

Die der Erfindung zugrundeliegende Aufgabe besteht « 
darin, ein verbessertes Verfahren zur Kollisionsvermei- 
dung mit Hilfe eines Lenkwinkelfeldes fur eine autono- 
me mobile Einheit anzugeben. 

Diese Aufgabe wird gemaB den Merkmalen des Pa- 
tentanspruches 1 geldst 65 

Weiterbildungen der Erfindung ergeben sich aus den 
Unteranspruchea 

Ein Vorteil des erfindungsgemaBen Verfahrens be- 



steht darin, daB durch seine Anwendung der Rechenauf- 
wand in der Steuereinheit einer autonomen mobilen 
Einheit verringert werden kann, dadurch Anwendung 
eines fest definierten Beobachtungsbereiches als 
Grundlage fflr eine Fahrwegplanung nur solche Hinder- 
nisse bewertet werden mussen, welche sich innerhalb 
dieses Beobachtungsbereiches befinden. 

Ein weiterer Vorteil des erfindungsgemaBen Verfah- 
rens besteht darin, mehrere Beobachtungsbereiche in 
Abhangigkeit Bewegungserfordernisse zu definieren 
und fur diese Beobachtungsbereiche jeweils separat 
auch fur mehrere Hindernisse, zulassige Lenkwinkelbe- 
reiche festzustellen. So kdnnen Hindernisse in unter- 
schiedlicher Entfernung der autonom operierenden Ein- 
heit separat bewertet werden und bei einer globalen 
Bewegungsplanung im Sinne einer Start-Ziel-Bewe- 
gung der autonomen mobilen Einheit besser beruck- 
sichtigt werden. 

Besonders gunstig ist es beim Vorhandensein von 
mehreren Hindernissen in der Umgebung, im Beobach- 
tungsbereich der autonomen mobilen Einheit die Lenk- 
winkelbereiche fur die Hindernisse separat festzustellen 
und abzuspeichern, weiterhin eine Schnittmenge dieser 
erlaubten Lenkwinkelbereiche zu bilden und diese in 
einem Lenkwinkelbereichsfeld abzuspeichern, welches 
fur eine aktuelle Position die erlaubten Lenkwinkel als 
Grundlage einer Fahrwegplanung angibt Durch diese 
Vorgehensweise wird die Planting fur einen Fahrweg 
erleichtert und die dafur bendtigte Rechenzeit in der 
Steuereinheit der mobilen Einheit verringert 

Um einen ZusammenstoB mit statischen Hindernissen 
zu vermeiden sieht es das erfindungsgemaBe Verfahrens 
gunstigerweise vor, daB um die Einheit herum eine Si- 
cherheitszone definiert wird, welche von keinem Hin- 
dernis durchdrungen werden darf. So wird sicherge- 
stellt, daB auch beim Auftreten von Hindernissen im 
Nahbereich der Einheit durch das erfindungsgemaBe 
Verfahren eine hohe Mandvrierfahigkeit gewShrleistet 
wird. Eine sichere Manovrierbarkeit der selbstbewegli- 
chen mobilen Einheit auch bei hohen Geschwindigkei- 
ten wird durch das erfindungsgemaBe Verfahren gunsti- 
gerweise sichergestellt in dem in Abhangigkeit der 
Fahrgeschwindigkeit der Beobachtungsbereich ent- 
sprechend angepaBt wird. 

Gunstig es fur kleine Fahrgeschwindigkeiten einen 
kleinen Beobachtungsbereich und fflr vergleichsweise 
groBe Fahrgeschwindigkeiten einen groBen Beobach- 
tungsbereich zu wahlen. In der Regel wird es so sein, 
daB die Einheit an engen Stellen mit einer kleinen Ge- 
schwindigkeit und an weiten Stellen mit einer groBen 
Geschwindigkeit fortbewegt wird. Durch das erfin- 
dungsgemaBe Verfahren wird so sichergestellt, daB die 
Strecke zwischen Start- und Zielpunkt moglichst schnel] 
durchfahren werden kann. 

Vorteilhaft wird mit dem erfindungsgemaBen Verfah- 
ren ein Lenkwinkelbereich als Schnittmenge von zwei 
erlaubten Lenkwinkelbereichen gebildet, die fur unter- 
schiedliche Beobachtungsbereiche gflltig sind. So wird 
gegebenenfalls eine langfristige Planung des Fahrweges 
erleichtert und eine optimale Geschwindigkeit der Ein- 
heit auf ihrem Fahrweg sichergestellt 

Um eine globale Fahrwegplanung zu erleichtern und 
mit angepaBter Geschwindigkeit fahren zu kdnnen, 
sieht es das erfindungsgemaBe Verfahren vorteilhafter- 
weise vor fur einen Beobachtungsbereich mindestens 
zwei Sicherheitszonen zu definieren und fflr diese Si- 
cherheitszonen separat die zugehorigen Lenkwinkelbe- 
reichsfelder zu ermitteln. So kann fahrsituationsabhan- 
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gig auf das jeweilig guliige Lenkwinkelbereichsfeld um- 
geschaltet werdea 

Eine zyklische Durchfuhrung des Verfahrens fOhrt 
dazu. daB schnell auf Anderungen in der Umgebung 
reagiert werden kana 5 

Vorteilhaft sieht es das erfindungsgemaBe Verfahren 
vor, auf nicht statische Hindernisse durch ROckwarts- 
fahrt zu reagierea 

Vorteilhafterweise wird durch das erfindungsgemaBe 
Verfahren auch eine Manovrierbarkeit der mobilen Ein- io 
heit durch enge Passagen sichergestellt, indem beim 
Auftreten von keinem zulassigen Lenkwinkelbereich 
die Sicherheitszone urn die Einheit herum verkleinert 
wird, urn bei der Berechnung der zulassigen Lenkwinke! 
einen hSheren Spielraum zu habea Im Extremfal) wird 15 
dabei die Sicherheitszone so klein gewahlt, daB sie mit 
den Gehauseabmessungen der mobilen Einheit uber- 
einstimmL 

Vorteilhaft laBt sich das erfindungsgemaBe Verfahren 
anwenden, wenn als lokale Karten zellular strukturierte 20 
Umgebungskarten verwendet werdea Auf diese Weise 
lassen sich Operationen, die Hindernisse betreffen, wie 
beispielsweise die Berechnung von Lenkwinkelfeldern 
mathematisch auf Matrizenoperationen zuruckfuhren 
und beschleunigen so den Rechenvorgang im Steuer- 25 
rechner, womit eine kilrzere Reaktionszeit erreicht 
wird. 

Im folgenden wird die Erfindung anhand von Figuren 
weiter erlautert 

Fig. 1 zeigt eine autonome mobile Einheit mit einem 30 
Hindernis. 

Fig. 2 zeigt eine autonome mobile Einheit mit mehre- 
ren Hindernissen. 

Fig. 3 zeigt eine autonome mobile Einheit mit einem 
Hindernis in der Sicherheitszone. 35 

Fig. 4 zeigt eine autonome mobile Einheit mit unter- 
schiedlichen Beobachtungsbereichea 

Fig. 5 veranschaulicht die Ermittlung eines Lenkwin- 
ke Is. 

Fig. 6 erlautert verschiedene Fallbeispiele bei der Er- 40 
mittlung eines Lenkwinkels fur die mobile Einheit 

In Fig. 1 ist eine autonome mobile Einheit zusammen 
mit einem Hindernis H dargestellt Um die autonome 
mobile Einheit, in der Folge Einheit genannt herum ist 
eine Sicherheitszone SZ1 gelegt Diese Sicherheitszone 45 
dient bei der Berechnung des Abstandes der Einheit zu 
Hindernissen als Kontur der Einheit Hierzu sind an der 
Sicherheitszone auBen Extrempunkte der Einheit vr, vl 
ml, hi, hr und mr vorgesehea Mit Hilfe der Kinematik 
der Einheit kann nun von einer Steuerung ein Winkel 50 
festgelegt werden, unter welcbem die Einheit bei Vor- 
wartsfahrt einen Kreisbogen beschreibt, der eben nicht 
zu einer Kollision mit dem Hindernis H fQhrt 

In der Figur ist fur den Winkel ©1 der maBgebliche 
Kreisbogen KB1 dargestellt welchen die Einheit bei 55 
Vorwarts-links-Fahrt beschreibt und der die Einheit am 
Hindernis H gerade eben vorbeifOhrt Der maBgebliche 
Berechnungspunkt fur die Kollisionsanalyse ist hierbei 
der Punkt vr auf der Sicherheitszone der Einheit AE. 

Zur Vorwarts-rechts-Fahrt ist der maBgebliche Win- 60 
kel 0a unter welchem die Einheit den Kreisbogen KB2 
beschreibt der sie bei Vorwarts-rechts-Fahrt an dem 
Hindernis vorbeifuhrt Vorbeifahrt an dem Hindernis 
bedeutet hier, daB der auf der Sicherheitszone befindli- 
che Extrempunkt vl gerade eben am Zentrum des Hin- 65 
dernisses H vorbeikommt ohne mit dem Hindernis zu 
kollidieren. 

Aus dieser Analyse der Vorwartsbewegung lassen 



sich zwei Winkel ©1 und © 2 ableiten, welche einen ver- 
botenen Lenkwinkelbereich LWBV beschreibea Dieser 
verbotene Lenkwinkelbereich umfaBt also alle Lenk- 
winkel unter welchen die autonome mobile Einheit AE 
mit dem Hindernis kollidieren wurde. Die Subtraktion 
dieses Lenkwinkelbereiches von 360° fOhrt zu einem 
erlaubten Lenkwinkelbereich LWB1. Dieser erlaubte 
Lenkwinkelbereich LWB1 umfaBt samtliche Lenkwin- 
kel unter denen die Einheit vorwarts oder ruckwarts 
fahren kann und unter denen sie nicht mit einem Hin- 
dernis H in der Umgebung kollidiert Vereinfacht ist 
hier nur ein Hindernis dargestellt Diese Analyse laBt 
sich jedoch auch ohne Einschrankung des erfindungsge- 
maBen Verfahrens fOr mehrere Hindernisse gleichzeitig 
durchfOhrea In Abhangigkeit des Standortes der auto- 
nomen mobilen Einheit AE erhalt man nach dieser Be- 
wegungsanalyse fflr den augenblicklichen Aufenthalts- 
ort, hier beispielsweise sei der Schnittpunkt des Koordi- 
natenkreuzes xy als Ort gewahlt, einen erlaubten Lenk- 
winkelbereich in Relation zu einem Hindernis in der 
Umgebung. 

Fig. 2 zeigt die Kollisionsanalyse der autonomen mo- 
bilen Einheit fur mehrere Hindernisse HI bis H3. In 
Abhangigkeit der Kinematik der Einheit und ihres 
Standortes, der sich hier im Schnittpunkt des Achsen- 
kreuzes XY befindet, ergeben sich in Bezug auf die 
einzelnen Hindernisse unterschiedliche erlaubte und 
verbotene Lenkwinkelbereiche. 

Die Bewegungs analyse wird durchgefuhrt wie es in 
Fig. 1 beschrieben wurde. Fur das Hindernis HI erhalt 
man einen verbotenen Lenkwinkelbereich LWBV1. Fin- 
das Hindernis H2 erhalt man einen verbotenen Lenk- 
winkelbereich LWBV2 und fur das Hindernis H3 einen 
verbotenen Lenkwinkelbereich LWBV3. Als Grundlage 
einer weiterfiihrenden Fahrwegplanung ist es unerheb- 
lich, ob die verbotenen Lenkwinkelbereiche oder die 
erlaubten Lenkwinkelbereiche zu Analysezwecken wei- 
terverarbeitet werdea 

Durch Bildung der Schnittmenge der einzelnen ermit- 
telten Lenkwinkelbereiche LWBV1 bis LBWB3 erhalt 
man das Lenkwinkelbereichsfeld LWBF. Hierin sind wie 
zuvor die verbotenen Lenkwinkel schwarz und die er- 
laubten Lenkwinkel weiB dargestellt 

Zur Erleichterung der Fahrwegplanung einer autono- 
men mobilen Einheit kSnnen in Abhangigkeit gewahlter 
Beobachtungsbereiche und Sicherheitszonen nur be- 
stimmte Hindernisse berucksichtigt werden und in Ab- 
hangigkeit des jeweiligen Standorts der Einheit AE un- 
terschiedliche Lenkwinkelbereichsfelder LWB1 abge- 
speichert werdea Die Abspeicherung in Feldern erlaubt 
es einfach mittels mathematischer Operationen auf die 
einzelnen Daten die je Hindernis gespeichert sind zu- 
zugreifea Beispielsweise kdnnen so fur mehrere Hin- 
dernisse gleichzeitig Belegungsgradwerte erhoht oder 
erniedrigt werdea 

Fig. 3 zeigt die Ermittlung eines Lenkwinkelbereiches 
fOr ein Hindernis, welches sich innerhalb der Sicher- 
heitszone der autonomen mobilen Einheit AE befindet 
Die zuvor getatigten Betrachtungen berucksichtigen 
hauptsachlich eine statische Umgebung. Fig. 3 veran- 
schaulicht einen TeD des erfindungsgemaBen Verfah- 
rens, der sich mit einer sich dynamisch andernden Um- 
gebung befafit 

Wie zuvor beschrieben wurde werden Hindernisse, 
welche sich auBerhalb der Sicherheitszone befmdea 
durch das erfindungsgemaBe Verfahren zuverlassig ver- 
mieden indem ein Kollisionsabstand vorausberechnet 
wird und entsprechende Lenkwinkelbereiche fur jedes 
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Hindernis definiert werden. Da sich jedoch auch Hin- 
demisse in der Umgebung bewegen kdnnen, zum Bei- 
spiel Menschen, oder auch Einrichtungsgegenstande 
verschoben werden kdnnen, kann es geschehen, daB ein 
Hindernis von der autonomen mobilen Einheit AE in- 5 
nerhalb ihrer Sicherheitszone bemerkt wird. Falls dies 
der Fall ist kann beispielsweise eine Steuerungsroutine 
der Einheit vorsehen, daB die Einheit sofort gestoppt 
wird und nun erneut ein Lenkwinkelbereichsfeld LWB1 
ermittelt wird. Wie in Fig. 3 dargestellt, fflhrt dies auto- 10 
matisch dazu, daB der verbotene Lenkwinkelbereich 
sehr groB und der erlaubte Lenkwinkelbereich LWB1 
sehr klein ist. Fiir die Winkel ©i und ©j ergeben sich 
wiederum die Kreisbdgen KB1 und KB2. Die erlaubten 
Lenkwinkel kdnnen nur durch Ruckwartsfahrt von der 15 
Einheit eingehalten werden. Ein Steuerprogramm der 
autonomen mobilen Einheit kann deshalb vorsehen, daB 
vor einem Hindernis abgestoppt wird, und daB Ruck- 
wartsfahrt eingeleitet wird. Die Ruckwartsfahrt kann 
dann beispielsweise im Rahmen einer globalen Bewe- 20 
gungsplanung innerhalb eines erlaubten Lenkwinkelbe- 
reiches LWB1 erfolgen. Nachdem das Hindernis H aus 
der Sicherheitszone SZ1 ausgetreten ist, kann im Rah- 
men einer globalen Fahrwegplanung wieder zur Vor- 
wartsfahrt Obergegangen werden und ein Lenkwinkel 35 
eingestellt werden, der auf dem kurzesten Weg zum Ziel 
fuhrt 

In Fig. 4 ist eine autonome mobile Einheit AE mit 
verschiedenen Beobachtungsbereichen BB1 und BB2 
dargestellt Weiterhin kdnnen unterschiedlich groBe Si- 30 
cherheitszonen safety_small und safetylarge erkannt 
werden. 

Fig. 4a zeigt eine autonome mobile Einheit mit der 
Sicherheitszone SZ1 und dem Beobachtungsbereich 
BB1. Vorteilhaft ist der Einsatz eines relativ kleinen Be- 35 
obachtungsbereiches, das heiBt klein zu den Dimensio- 
nen der autonomen mobilen Einheit AE, bei langsamen 
Geschwindigkeiten und in engen Passagen. HierfQr wird 
vorteilhafterweise auch eine enge Sicherheitszone SZ1 
gewahlt damit bei der Fahrwegplanung und Kollisions- 40 
analyse durch Beriicksichtigung eines Sicherheitsab- 
standes keine Mandvrierfahigkeit verschenkt wird. 
Durch die Wahl eines kleinen Beobachtungshorizontes 
BB1 wird erreicht daB nur wenige Hindernisse im Nah- 
bereich der automobilen Einheit evaluiert werden mus- 45 
sen. Damit wird beispielsweise ein Steuerrechner, wel- 
cher die Bewegungsplanung durchfQhrt, in der Steuer- 
einheit der autonomen mobilen Einheit entlastet Bei- 
spielsweise kann deshalb auch die Evaluationsgeschwin- 
digkeit fur Hindernisse im Nahbereich der Umgebung 50 
erhdht werden. Dies bedeutet eine Evaluation von bei- 
spielsweise Sensordaten kann mit bdherer Geschwin- 
digkeit erfolgen, da nur wenige Hindernisse berucksich- 
tigt werden mussen. Es ist auch denkbar, daB in einer 
engen Passage mehrere Hindernisse auftreten und diese 55 
bei der Berechnung der zulassigen Lenkwinkel zu 
Schwierigkeiten fuhren weshalb ein erhdhter Rechen- 
auf wand notwendig wird. 

Fig. 4b zeigt eine autonome mobile Einheit mit einem 
Beobachtungsbereich BB2, welcher grdBer ist als der in 60 
Fig. 4a dargestellte BB1 mit zwei Sicherheitszonen safe- 
ty_small und saf ety_large. 

Beispielsweise soil bier sichergestellt werden, daB die 
autonome mobile Einheit AE auch bei schneller Vor- 
warts- oder Ruckwartsfahrt nicht mit Hindernissen kol- 65 
lidiert In Abhangigkeit der Fahrgeschwindigkeit der 
Einheit kann deshalb eine grdBere Beobachtungszone 
BB2 gewahlt werden. Damit wird einem Steuerrechner 
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eine weiterreichende Fahrwegplanung ermdglicht Die- 
se Vorgehensweise bietet sich auch an, wenn wenige 
Hindernisse in der Umgebung vorhanden sind, so daB 
durch eine geeignete Wahl eines Beobachtungsberei- 
ches BB2 beispielsweise die Zahl der zu evaluierenden 
Hindernisse immer konstant gehalten werden kann. Da- 
mit kann beispielsweise eine gleichmlBige Auslastung 
des Rechners erreicht werden bzw. eine Uberlastung 
verhindert werden. Zur {Compensation der Massentrag- 
heit bei schneller Vorwartsfahrt der autonomen Einheit 
AE kdnnen unterschiedlich groBe Sicherheitszonen sa- 
fety_small und safety_large gewahlt werden. In Abhan- 
gigkeit einer Fahrgeschwindigkeit wird zum Beispiel bei 
kleiner Geschwindigkeit safety_small und bei groBer 
Geschwindigkeit safety_large gewahlt Es ist aber auch 
denkbar, daB zu ermittelnde Lenkwinkelbereichsfelder 
simultan fflr die groBe und fur die kleine Sicherheitszo- 
ne ermittelt werden. Lenkwinkelbereichsunterschiede, 
die sich aus dem Beobachtungsbereich BB2 und dem 
unterschiedlichen groBen Sicherheitszonen ergeben, 
kdnnen fur die Fahrwegplanung ausgewertet werden. 
Beispielsweise kann beim Eintritt eines Hindernisses in 
die Sicherheitszone safety_large ein Abbremsvorgang 
der autonomen mobilen Einheit eingeleitet werden. 

Fig. 5 zeigt wie aus einer Kombination von unter- 
schiedlichen Sicherheitszonen SZ2 und SZ1 mit unter- 
schiedlichen Beobachtungshorizonten ein erlaubter 
Lenkwinkel gefunden werden kann. 

Hier werden exemplarisch nur drei Kombinationen 
FN, FM und FG betrachtet Es sind durchaus andere 
Kombinationen von Sicherheitsabstaiiden und Beob- 
achtungsbereichen denkbar. Ohne das erfindungsgemS- 
Be Verfahren zu beeintrachtigen sind verschiedene 
Kombinationen aus Sicherheitszonen und Beobach- 
tungsbereichen mdglich, ura eine Fahrwegplanung glo- 
bal oder auch lokal fur die autonome Einheit durchzu- 
fuhren. Hier sind exemplarisch drei Kombinationen an- 
gegeben, mit welchen experimentelle Untersuchungen 
durchgefuhrt wurden und die sich als gunstig herausge- 
stellthaben. 

Mit FN wird ein Nahfeld angegeben in welchem die 
Sicherheitszone sehr klein gewahlt wird, das heiBt bei- 
spielsweise im Bereich von 1 cm liegt und der Beobach- 
tungsbereich im Bereich von 15 cm liegt In der Regel 
sollte FN angewendet werden im Nahbereich bei klei- 
ner Geschwindigkeit und beim Durchfahren enger Pas- 
sagen. Bei den Kombinationen FM und FG ist ein kon- 
stanter Beobachtungsbereich mit beispielsweise einer 
Ausdehnung von 45 cm vorgesehen, wobei jedoch der 
Kollisionsanalyse bei FM eine kleinere Sicherheitszone 
SZ1 und fur FG eine grdBere Sicherheitszone SZ2 zu- 
grundegelegt wurde. 

Da sich direkt vor der Einheit das Hindernis H befin- 
det, kann der erste im Rahmen einer globalen Fahrweg- 
planung festgelegte Lenkwinkel des_steerl nicht einge- 
halten werden. Es muB deswegen ein Ausweichwinke) 
des_steer2 gefunden werdea Wie erkannt werden kann 
ergibt sich in FN kein zulassiger SteuerungswinkeL 
Ebenso kann erkannt werden, daB in FG kein zulassiger 
Lenkwinkel gefunden wird, der noch Vorwartsfahrt der 
autonomen mobilen Einheit erlaubt Lediglich in FM 
ergibt sich der Steuerungswinkel des_steer2 als zulassi- 
ger Steuerungswinkel, denn er befindet sich im weiBen 
Bereich, das heiBt im zulassigen Lenkwinkelbereich. 
Hier wird plastisch veranschaulicht, daB durch eine Va- 
riation der GrdBe der Sicherheitszone, hier ein Uber- 
gang von SZ2 nach SZ1 und eine geeignete Wahl eines 
Beobachtungsbereiches, beispielsweise 45 cm auch in 
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engen Passagen, oder vor Hindernissen ein optimaler 
Lenkwinkel gefunden werden kana Optimal bedeutet 
hier es wird zwar nicht direkte Vorwartsfahrt erreicht, 
wie sie durch des steerl vorgegeben wird, jedoch kann 
ein Lenkwinkel gefunden werden, der immerhin noch 5 
eine Fahrt in Richtung des Zieles der autonomen Einheit 
erlaubt Solche Ausweichmanover k6nnen durchaus im 
Rahmen einer Bewegungssteuerung und einer globalen 
Fahrwegplanung beispielsweise mit einem Wandfolge- 
verfahren kombiniert werden. 10 

Fig. 6 zeigt ein weiteres Beispiel zur Ermittlung eines 
Lenkwinkels fur eine autonome mobile Einheit In 
Fig. 6a ist dargestellt daB sich der gewunschte Steuer- 
winkel, welcher beispielsweise im Rahmen einer globa- 
len Fahrwegplanung ermittelt wurde, und der resultie- 15 
rende Steuerwinkel des_steer und ressteer Oberein- 
stimmen und diese gefahren werden konnea 

In Fig. 6b ist veranschaulicht wie beispielsweise ein 
anderer resultierender Steuerwinkel res_steer als der 
gewunschte Steuerwinkel des_steer gewahlt wird, ob- 20 
wohl beide innerhalb eines erlaubten Lenkwinkelberei- 
ches anzutreffen sind. Wie Fig. 6b zeigt, ist der erlaubte 
Lenkwinkelbereich sehr kleia Diese Situation kann ein- 
treten, wenn sich die selbstbewegbche mobile Einheit 
innerhalb einer engen Passage bewegt Um fur die Wei- 25 
terfahrt optimale Ausweichmoglichkeiten bieten zu 
kSnnen, wird der resultierende Steuerwinkel res_steer 
in der Mitte des erlaubten Lenkwinkelbereiches einge- 
stellt Dies hat zur Folge, daB sich die autonome Einheit 
AE exakt in der Mitte zwischen zwei ermittelten Hin- 30 
dernissen, oder in der Mitte einer engen Passage bewe- 
genkana 

Fig. 6c zeigt ein weiteres Beispiel zur Ermittlung ei- 
nes gultigen Lenkwinkels. Auch hier ist der gewunschte 
Steuerwinkel dessteer angegeben und der resultieren- 35 
de Lenkwinkel res_steer gezeigt Da sich der gewunsch- 
te Steuerwinkel innerhalb eines verbotenen Lenkwin- 
kelbereiches befindet muB ein Steuerwinkel gefunden 
werden, welcher sich innerhalb des zulassigen Lenkwin- 
kelbereiches befindet Hierzu sieht es das erfindungsge- 40 
maBe Verfahren vor, beispielsweise den gewunschten 
Steuerwinkel um eine festgelegte experimentell be- 
stimmte Schrittweite zu variieren, um einen resultieren- 
den Steuerwinkel zu finden, der sich innerhalb des er- 
laubten Lenkwinkelbereiches befindet Um eine Aus- « 
weichrichtung festzulegen wird die Variation beispiels- 
weise zunachst links und dann rechts probiert So wird 
festgestellt, ob durch die gewahlte Wuikelvariation sec- 
tor_width2 ein resultierender Lenkwinkel gefunden 
werden kann, der sich innerhalb des erlaubten Lenkwin- 50 
kelbereiches befindet In Fig. 6c fahrt die Variation des 
gewunschten Steuerungswinkels mit sector_width2 
nach rechts zu einem gangbaren Ergebnis. Es ist weiter- 
hin denkbar, daB die Variationsschrittweite in Abhan- 
gigkeit der GrdBe der verbotenen Lenkwinkelbereichs- 55 
zone vergroBert oder verkleinert wird. Die in Fig. 6a bis 
c dargestellten Strategien wurden experimentell durch 
eine gute Fahrwegplanung bestatigt 

Voneilhaft laBt sich das erfindungsgemaBe Verfahren 
vor alien Dingen beim Einsatz von zellular strukturier- 60 
ten Umgebungskarten zur Orientierung der autonomen 
mobilen Einheit einsetzea Die Lenkwinkelbereiche fflr 
die einzelnen Hindernissen lassen sich besonders ein- 
fach in einem Feld abspeichern, auf das wahrend der 
Bewegung der mobilen Einheit global zugegriffen wer- 65 
den kann. Translationen, oder auch die Verringerung 
von Belegungsgradwerten lassen sich so fur alle Hinder- 
nisse gemeinsam durchfuhrea 



Allgemein kann beispielsweise wie folgt vorgegangen 
werden: 

Bei der folgenden Beschreibung werden wechselweise 
die Fig. 5 und 6 referenziert Die Bezugnahme laBt sich 
aus den jeweiligen Bezugszeichen ableiten. 

Es wird vorzugsweise versucht zuerst immer einen 
passenden Lenkwinkel im Bereich FG zu finden. damit 
die Einheit den groBeren Sicherheitsabstand zu den 
Hindernissen halt Die Geschwindigkeit der Einheit 
kann dann auch relativ groB gewahlt werden. 

1st der gewunschte Lenkwinkel (des steer) verboten, 
so wird im Bereich FG von des steer aus nach links und 
rechts bis zu einer maximalen Suchweite (search_width 
= 90°) gesucht ob ein Lenkwinkel erlaubt ist Der nach- 
ste erlaubte Lenkwinkel wird dann gefahren. Bei 
des_steer2 in Fig. 5 wird z. B. der Lenkwinkel a gefah- 
rea 

Wird innerhalb search width kein erlaubter Lenkwin- 
kel im Bereich FG gefunden, so wird mit dem selben 
AJgorithmus im Bereich FM nach einem passenden 
Steuerungswinkel gesucht Bei dessteerl wird z. B. im 
Bereich FG kein Lenkwinkel gefundea Im Bereich FN 
wird dann der Lenkwinkel b gefundea Falls ein Lenk- 
winkel aus dem Bereich FM zum Fahren genommen 
wird, so wird auch die Geschwindigkeit reduziert, da der 
Sicherheitsabstand kleiner ist 

Wird sowohl im Bereich FG als auch im Bereich FM 
kein Lenkwinkel gefunden, dann schwenkt die Einheit 
beispielsweise auf der Stelle hin und her. Dadurch sollen 
falschlicherweise belegte Gridzellen in einer zellular 
strukturierten Karte geloscht werden. 

Ist der gewunschte Lenkwinkel des_steer befahrbar, 
dann wird zum Beispiel zusatzlich noch geprflf t, ob nach 
links und nach rechts noch einige Lenkwinkel befahrbar 
sind. 

Sind in jede Richtung bis mindestens sector_width/2 
die Lenkwinkel noch befahrbar, so wird wie in Fig. 6a 
ressteer identisch des_steer gewahlt 

Sind nach links und rechts nicht mehr ausreichend 
viele Lenkwinkel erlaubt so wird res steer beispiels- 
weise so gewahlt, daB er sich wie in Fig. 6b in der Mitte 
eines erlaubten Lenkwinkelbereiches befindet Diese 
MaBnahme hat zur Folge, daB die Einheit in einer engen 
Passage genau in der Mitte fahrt 

Befindet sich der gewunschte Lenkwinkel in einem 
verbotenen Bereich, so wird in beiden Richtungen nach 
einem erlaubten Lenkwinkel gesucht Wenn nun ein er- 
laubter Winkel gefunden wurde, so wird beispielsweise 
emeut die Mitte eines erlaubten Sektors gesucht Ist die 
Menge der gefundenen erlaubten Lenkwinkel grdBer 
als sector width, dann wird zum Beispiel derjenige 
Lenkwinkel ausgewahlt, der wie in Fig. 6c 
sector_width/2 vom ersten erlaubten Lenkwinkel ent- 
ferntist 

Dies bewirkt, daB die Einheit beim Vermeiden von 
Hindernissen etwas starker als unbedingt notwendig 
ausweicht, wenn genugend freier Platz vorhanden ist 
Diese Verhaltensweise ist sinnvoll, da die Einheit dann 
mehr Platz zum Hindernis IaBt und nicht so stark ab- 
bremsen muB. 

Die Lenkwinkelbereichsfelder kdnnen sehr gut zur 
Geschwindigkeitssteuerung verwendet werdea 

Eine einf ache Geschwindigkeitssteuerung ist mdglich, 
wenn man jedem Lenkwinkelbereichsfeld einen Ge- 
schwindigkeitsfaktor zuordnet 

v_ref = speed_factor • v_ref_max 
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vref ist die Geschwindigkeit, die das virtuelle Antriebs- 
rad (Nachlaufrad) fahren soil v_ref_max ist eine vorge- 
gebene maximale Geschwindigkeit Wird nun ein Lenk- 
winkel aus dem Bereich FG genommen, so wird auch 
der entsprechende Geschwindigkeitsfaktor fflr dieses 5 
Feld eingestellt. Der Geschwindigkeitsfaktor fur dieses 
Feld betragt beispielsweise 1.0, dh. maximale Ge- 
schwindigkeit, da hierfflr die grdBte Sicherheitszone 
verwendet wird Die Geschwindigkeits-Faktoren der 
Bereiche FM und FN sind angemessen kleiner zu wah- 10 
lea 

Patentanspruche 

1. Verfahren zur Kollisionsvermeidung fflr eine au- 15 
tonome mobile Einheit, 

a) bei dem unter Zuhilfenahme mindestens der 
Antriebs- und Lenkgeometrie, sowie der aufie- 
ren Abmessungen der mobilen Einheit minde- 
stens der kflrzeste Fahrweg der Einheit von 20 
ihrem Standort bis zur Collision mit minde- 
stens einem Hindernis als Kollisionsabstand 
ermittelt wird, 

b) bei dem unter Verwendung der Geometrie- 
daten aus a) und des Kollisionsabstandes je- 25 
weils ein an der Einheit einzustellender Lenk- 
winkel ermittelt wird, der bei Rechts- und 
Linksvorbeifahrt der Einheit am mindestens 
einen Hindernis eben nicht zu einer {Collision 
mit dem Hindernis fflhrt, so daB sich daraus ein 30 
erster erlaubter Lenkwinkelbereich in Bezug 
auf den Standort der autonomen mobilen Ein- 
heit ergibt, 

c) und bei dem nur solche Hindernisse berflck- 
sichtigt werden, welche sich innerhalb eines 35 
festgesetzten variablen Beobachtungsberei- 
ches zwischen der Einheit und einer um sie 
herumgezogenen Grenzlinie befinden. 

2. Verfahren nach Anspruch 1, bei dem mindestens 
zwei Beobachtungsbereiche festgesetzt werden, 40 
wobei ein erster Beobachtungsbereich vergleichs- 
weise klein zu den Abmessungen der Einheit, und 
ein zweiter Beobachtungsbereich vergleichbar mit 
den Abmessungen der Einheit festgesetzt und je- 
weils mindestens ein erlaubter Lenkwinkelbereich 45 
bestimmt wird. 

3. Verfahren nach einem der obigen Ansprflche, 

a) bei dem je Hindernis mindestens ein erlaub- 
ter Lenkwinkelbereich ermittelt und in einem 
Lenkwinkelbereichsfeld abgelegt wird 50 

b) und bei dem der fur die autonome mobile 
Einheit erlaubte Lenkwinkelbereich als 
Schnittmenge aus mehreren erlaubten Lenk- 
winkelbereichen des Lenkwinkelbereichsfel- 
des gebildet wird. 55 

4. Verfahren nach einem der obigen Ansprflche, bei 
dem lediglich solche Hindernisse berflcksichtigt 
werden, welche sich auBerhalb einer Sicherheitszo- 
ne um die autonome Einheit herum befinden, wobei 
die Sicherheitszone kleiner als der Beobachtungs- 60 
bereich ist 

5. Verfahren nach einem der Ansprflche 2 bis 4, bei 
dem der Beobachtungsbereich in Abhangigkeit ei- 
ner von der Einheit gefahrenen Fahrgeschwindig- 
keit gewahlt wird 65 

6. Verfahren nach Anspruch 5, bei dem fur ver- 
gleichsweise kleine Fahrgeschwindigkeit minde- 
stens der erste Beobachtungsbereich und fur ver- 
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gleichsweise groBe Fahrgeschwindigkeit minde- 
stens der zweite Beobachtungsbereich gewahlt 
wird. 

7. Verfahren nach einem der Ansprflche 2 bis 6, bei 
dem der erlaubte Lenkwinkelbereich als Schnitt- 
menge des fur den ersten Beobachtungsbereich er- 
laubten Lenkwinkelbereiches mit dem fur den 
zweiten Beobachtungsbereich erlaubten Lenkwin- 
kelbereich gebildet wird. 

8. Verfahren nach einem der Ansprflche 4 bis 7, bei 
dem fflr mindestens einen Beobachtungsbereich 
mindestens zwei Sicherheitszonen festgesetzt, und 
die jeweils zugehorigen Lenkwinkelbereichsfelder 
ermittelt werden. 

9. Verfahren nach einem der vorhergehenden An- 
sprflche das zyklisch ausgef flhrt wird 

10. Verfahren nach Anspruch 9, bei dem nach Fest- 
stellung eines Hindernisses in einer Sicherheitszo- 
ne, die autonome mobile Einheit rflckwarts fahrt 

11. Verfahren nach einem der Ansprflche 2 bis 11, 
bei dem falls kein erlaubter Lenkwinkelbereich be- 
stimmbar ist, dies dazu fflhrt, daB die Sicherheitszo- 
ne verkleinert wird 

12. Verfahren nach einem der vorhergehenden An- 
sprflche, bei dem die autonome mobile Einheit sich 
anhand einer zellular strukturierten Umgebungs- 
karte orientiert und ein Hindernis in der Karte 
durch einen Belegungsgrad angezeigt wird 
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